catkin_add_gtest(${PROJECT_NAME}_test test.cpp)
target_link_libraries(${PROJECT_NAME}_test ${catkin_LIBRARIES})
